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SUMMARY 


Transformation matrices from one joint axis system to another are used in the 
control of robot arms and in the passage of sensor information along the arms. The 
Denavit-Hartenberg parameters/ which precisely describe the relative location of one 
joint axis system with respect to another, define the elements in these matrices. 

This paper presents a vector-algebra approach to extract the Denavit-Hartenberg 
parameters for any assembled robot arm. 

Measurement data needed in the parameter-extraction process can be generated by 
varying the joint angles in a robot arm and measuring the location of a point on the 
robot hand (or other extension) . The Denavit-Hartenberg parameters relating consecu- 
tive joint axis systems are then calculated with these data. The parameter- 
extraction method appears promising as a useful tool for researchers and may possibly 
be a useful industrial procedure. 


INTRODUCTION 

Researchers are currently trying to improve the control and design of robot arms 
and to add a certain degree of autonomy for future space applications, such as the 
service and repair of satellites (ref. 1). Commercially available (or prototype) 
robot arms are used to verify concepts, validate mathematical models, and realize 
operational problems. However, a difficulty arises in that parameters in the mathe- 
matical equations necessary to describe these arms are not always available or the 
supplied parameters are not sufficiently accurate for end-point control. 

If an operator remotely controls the hand of a robot arm by commanding transla- 
tional and rotational rates about the hand axis system, then these rates must be 
resolved mathematically into joint rates along the arm to effect these commands 
(resolved-rate control, ref. 2). This resolution depends on the location of the 
joints relative to each other. These locations are usually not available and are 
difficult to measure for assembled commercially available robot arms. But, in stud- 
ies involving the control of these arms, this information is required. 

Because researchers often use robot arms in a manner other than that for which 
they were originally intended (for example, some robot arms were not originally 
intended to be controlled in a teleoperator mode by resolved rate), necessary param- 
eters are often not available for the requisite mathematical models. Moreover, cer- 
tain parameters may represent proprietary information. Whatever the reason, there is 
a definite need for an accurate method to extract these parameters without having to 
disassemble the robot arms. Such a method may also prove useful in the extraction of 
a new set of definitive parameters to allow resumed control of a misaligned or bent 
robot arm, for example on a factory floor or in a space application of a rigid-body 
manipulator; via industrial enhancements, such a method may be useful in the routine 
factory calibration of robot arms. 

The purpose of this paper is to develop a vec tor- algebra approach for calculat- 
ing the relative joint geometry of an assembled robot arm. Specifically, the 
Denavit-Hartenberg parameters (ref. 3) , which completely characterize this geometry, 
are calculated. 
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homogeneous transformation matrix from coordinate system i to i - 1 
length of a^ 

common normal vector between and Z i 

vector from world coordinate system to center of circular trajectory of 
point F about line of rotation for joint i 

point on extension attached to robot hand 

integer to indicate different axis systems and associated parameters 
constant defined by equation (6) 

integer argument used to label corresponding measurement data 

vector from world coordinate system to general point on line of rotation for 
joint i 

->•* 

vector from world coordinate system to point where v. touches line of 
rotation for joint i 

number of unit vectors u^OO to be averaged 
origin of joint i and world axis system, respectively 
measured position vector in world coordinates to point F 
measured vector P. associated with measurement data set k 

l 

point in three-dimensional space 

position vector from origin of world coordinate system to origin of 
coordinate system i 

length of r. ; relative distance between coordinate systems i - 1 
and i along 

vector along from origin of coordinate system i - 1 to tail of a^ 

vector from world coordinate system to tail of vector (see fig. 8) 

unit vector normal to plane of circular trajectory of point F and in 
direction of rotational vector co. 

l 

calculated unit vector u. associated with measurement data set k 

i 

vector drawn from point on line of rotation for joint i to point on line 
of rotation for joint i + 1 

vector v. with minimum length; normal vector between lines of rotation for 
joints i and i + 1 
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axis directed along common normal between and Z^ 


x w /Y w' Z w 


x i'*i' z i 


x w'*w' z w 


a. 

x 


0 ± <k) 
AS (k) 


* 

x 


world coordinate axes 

coordinate along X Y^, and z^, respectively 
world coordinate along X w , Y w# and Z w , respectively 

axis directed to complete right-hand axis system with x i and z^ 

axis of rotation of joint i + 1 

angle between and Z i# measured positively (as shown in fig. 3) about 

positive X ^ 

constant bias angle, which when summed with joint angle 0., yields joint 
angle 0^ 

joint angle with initial value corresponding to position of robot arm 
in figure 1 

joint angle 0^ associated with data set k 

incremental changes in joint angle 0^(k) 

joint angle between and X measured positively (as shown in fig. 3) 

about positive 

real variable in vector line equation 

value of \ which makes v^ normal to line of rotation of joint i 

radius of circular trajectory of point F about line of rotation for 
joint i 


W. 


unit vector in direction of u. x u. , „ 

x x+1 

rotational velocity of joint i 


Mathematical notations: 


length of vector 

dot or scalar product 

cross or vector product 


ANALYSIS 

A robot arm with rotational joints is depicted in figure 1. As shown by the 
inset of wrist motions in this figure, 9^ corresponds to a rotation of the bottom 
of the wrist assembly mounted at the end of the arm, whereas 9 g directly rotates 
and 0 5 tilts the cylindrical element (end effector) which is attached to the 
wrist. In reality, a mechanism which opens and closes is attached to the wrist for 
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manipulating objects. The robot arm in figure 1 is used for illustration, but the 
subsequent development is valid for any geometric configuration of robot arm. 

Suppose the exact location and orientation of each joint axis system of the 
robot arm in figure 1 are not known. The objective in this analysis is to develop a 
method to determine the parameters which establish the geometric relationships among 
the joint axis systems for an assembled robot arm. This objective is accomplished by 
moving the arm to different positions and making certain measurements, which are 
later used in equations to extract the desired parameters. 


Measurements 

Joint angle measurements .- As a point of reference for joint angle measurements, 
define 0, = 0 (i = 1 , 2, . . . , 6) for the initial position of the robot arm shown in 
figure 1. Thereafter, these joint angles are referenced to this initial zero 
position. 

World coordinates .- The world reference axis system indicated in figure 2 is an 
arbitrarily fixed axis system. For example, the origin of this axis system may be 
located at the corner of a flat table upon which the robot arm is stationed, or the 
world axis system may correspond to the axis system of a laser transit or a camera. 
With respect to this world axis system, the rectangular coordinates (x w ,y w ,z w ) of the 
point F in figure 2 are obtained. The point F is located arbitrarily on some 
extension of the robot hand so that when a rotation occurs, by varying a joint angle 
0^, the point F will move to another position in the world coordinate space. It is 
not necessary to know the length or orientation of the extension. 

The robot arm is moved to different positions by varying its joint angles. At 
each new position, the joint angles 0^ are available from sensors in the robot arm 
itself, whereas the location of point F is actually measured by using external 
measurement devices (sensors). It is assumed that measurements of joint angles 0^ 
and corresponding world coordinates of point F are available for the robot arm in 
different positions for this analysis. Before proceeding, the axis systems to be 
established are described. 


Joint Axis Systems 

Figure 3 illustrates the axis systems associated with joints i and i + 1. By 
convention, joint i is associated with the coordinate system i - 1. Hence, 
joint i corresponds to the axis system with origin at Oj^, whereas joint i + 1 
corresponds to the other axis system with origin 0^. By definition, the axis of 
rotation for joint i always lies along the associated Z^_ ^ . The vector cL is 
the normal vector between and Z^, being directed toward Z^. The inter- 

section point of a i with Z i locates the origin O^. The axis X i originates 
from 0 ^ in the same direction as . In the event that and z ± intersect 

(fig. 3(b)), a^ is the zero vector, and x i is then directed from this intersec- 
tion in the direction of the cross product obtained by ^multiplying a unit vector 
along by a unit vector along Z^. The vector r^ is the vector from the 

origin 0 i-1 to the^intersection of a ± with Z ± _ 1 (fig. 3(a)); for intersecting 
lines of rotation, r. is a vector along Z^ from Ct_ ^ to 0. (fig. 3(b)). The 
angle ql is the angle between a line parallel to through the origin 

and Z^, being measured positive about positive (fig. 3). Finally, the joint 
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angle 0^ is the angle between and a line parallel to X^ through and 

is measured positive about positive Z i _ 1 (fig. 3). The axes Y ± and which 

simply complete right-hand axis systems, are not shown for clarity. 

The lengths of a. and r. are denoted by a. and r* • The relative -joint 
"11 h i J 

parameters a^ , r^, and and the joint angle 0^ are referred to as the 

Denavit-Hartenberg parameters (ref. 2) and corrpletely characterize the relative joint 
geometry . 

Basic coordinate transformation .- The relative joint geometry dictates the basic 
transformation equations between adjacent joints. The coordinates of a point 
Q(x,y,z) with respect to the coordinate system i in figure 3 can be transformed to 
coordinates of Q with respect to the coordinate system i - 1 by the relation: 
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where A^-_ ^ is the homogeneous transformation matrix from coordinate system i to 
i - 1 (ref. 4, for example) . This basic transformation matrix, whose elements are 
defined by the Denavit-Hartenberg parameters, is used in controlling a robot arm and 
in transforming sensor signals along the arm. 

Relationship between joint angles 0^ and 0^.- If the convention in figure 3 

were used to define axis systems for the robot arm in figure 1, the joint angles 
would be 0^ (i = 1 , 2, . . . , 6) . In general, the joint angle 0^ is not equal to 
the joint angle 0^, which is referenced to the initial condition of the robot arm in 
figure 1. At this time, 0^ is measurable, but 0^ is not measurable because the 
axis systems have not yet been established. Corresponding values of 0^ and 0^ 
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result from application of the subsequent parameter extraction equations, and if 
required, a nonlinear relationship could be formed. However, most often, this func- 
tional relationship is adequately described by the linear equation: 


e ± = h + P ± (3) 


where (3^ is a constant bias, reflecting an initial offset in 0^. Hence, if a 
calculated value of 0^ corresponds to a measured value of 0^, then (3. is calcu- 
lated by using these values in equation (3). 


Problem Statement 

Given the world coordinate system in figure 4, let the location of the point 
°i-1 an<i the ^i rect i° n of x i-l be ^ nowru Now, with joint angles 0^ and corre- 
sponding locations of point F (fig. 2) , calculate the Denavit-Hartenberg param- 
eters a^, a j_, and r^, and the joint angle 0^. Furthermore, find the origin 
of the next axis system, which is located somewhere on the dashed line for and 

the direction of X^. The process is then repeated to establish subsequent axis 
systems. To initiate the process, use the origin 0 W and the direction of X w 
which are specified. 


Circular Trajectory of Point F 

In figure 2, let 0^ vary and the remaining 0.^ be fixed. Then, the point F 
on the robot arm will generate a circular trajectory about Z Q . in general, as 0^ 
varies, the point F will generate a circular trajectory about For a value 

of 0^, the location of point F in world coordinates can be measured (for example, 
see appendix A). 

Center of circular trajectory .- Figure_^5 shows the circular trajectory of 
point F ^ caused by changing 0^ (where II to. II is the time derivative of 0^). The 
vector P. (k) gives the position of F in world coordinates when 0^ has the value 
0j_(k), where k has been introduced to label corresponding data. The center of the 
circular trajectory in figure 5 is given by the constant vector C, . The components 
of this vector are computed by forming the dot product: 
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which can also be expressed as 
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where 


K. 

x 



-V 

% C. 


X 



is a constant. 


( 6 ) 


Equation (5) represents k ^linear equations in four unknowns: and the 

three components of the vector C^. Four different position vectors (?.(k) f 

k = 1 r 2 t 3 , and 4) are sufficient to provide enough equations for the solution of 
these constants. Thus, a robot arm with 6 rotational joints would require 24 
position measurements (4 for each of the 6 joints). Each position vector is made up 
of three components , representing a point in the world coordinate system ( X w /Y w /Z w )* 
In actual situations/ where sensor errors are present, more measurements will be 
needed to allow least-squares estimates of the constants. 

Once the vector £. and the scalar K, are found, the radius of the circle is 

X 1 

given by equation (6), written as 


Pi 



+ 2K. 

X 


(7) 


Unit vector 


position vectors 


u. Figure 6 shows the circular trajectory of point F and two 
? i (k) and P^Ck+1), along with the incremental joint angle 


A0, (k) = 0. (k+1) - 0. (k) 

xx x 


( 8 ) 


between these position vectors. A unit vector normal to the plane of the circular 
trajectory and passing through point (whose coordinates are the components of 
the vector Ct) is 


u. (k) 

X 


fc. lk) - j l] * Pi (k+1) - 
2 

Pi 


(9) 
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With 0 < A0.(k) < it, u.(k) in equation (9) is in the same direction as the rota- 
i 4 . 1 -> 

tional vector An average over M vectors 

M 

3 i-sZ 3 i <k> (, ° 

k =1 


should be used to reduce the effects of errors in actual measurements. 


Lines of Rotation and Transverse Vector 

Figure 7 shows lines of rotation for joints i and i + 1. Any point on the 
line of rotation for joint i is representable by the vector line equation 


1 = C + X u ( 11 ) 

i i i i 


Likewise, any point on the line of rotation for joint i + 1 is described by 


Z = C + X u 
i +1 i +1 i +1 i +1 


Define a transverse vector v. between these lines of rotation as 

1 


( 12 ) 


-* -* -> 

v = X - Z 

i i +1 i 


(13) 


Parallel lines of rotation (u^ x = 0? • u ^ +1 = ±l).~ First of all, 

coincident lines of rotation for consecutive joints are not of interest because these 
joints are effectively one and not distinguishable. Therefore, in figure 7, for 
parallel lines. 



C. * 0 
1 


(14) 
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For parallel lines of rotation, the point F in figure 2 generates circular trajec- 
tories in figure 7 which lie in the same plane? therefore. 


-►* -► -* 

v - C - C (15) 

i i+1 i 

is normal to these lines and has a length equal to their distance of separation. 
Equation (15) is equation (13), with = ^i+1 = Relocate v* so that its ini- 
tial point is the known location of the origin on the line of rotation for 

joint i? that is. 


A, « R. „ (16) 

i 1-1 


where is the vector from the world axis system to (fig- 8). Then, the 

corresponding terminal point of on the line of rotation for joint i+1 is 


->* 

A 

i+1 



+ v 

i 


(17) 


In effect, equatipn (16) reflects the assignment of r. = 0 to parallel lines of 
rotation. 


S kew lines of rotation .- If the lines of rotation in figure 7 are not parallel. 


^ * 

let and those values of and \ in equations (11) and (12), 

respectively, which make v^ in equation (13) normal to the lines of rotation. 

+ ->* 

Denote this vector v^ by v^- Then, 


->* ->* ->* 

v « A - A (18) 

i i+1 i 


where 


-* * + 

A. = C. + X. u. 

i+l i+l i+I i+I 
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and 


->* -y * + 

1 = C + \ u (20) 

i i i i 

are the intersection points of v* with the lines of rotation* By definition of 
v^, two orthogonality conditions are 


*>* -* n 
v. • u. = 0 
1 x 


and 


->* 

v. 
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*i+i 


o 


( 21 ) 


( 22 ) 


Equations (21) and (22) can be solved simultaneously for the scalar values X* and 
x£ +1 to get 
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where, for skewed lines. 
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Relative Joint Geometry 


In figure 8/ S and r represent position vectors in world coordinates where 
i i 


a. intersects the lines of rotation for joints i and i + 1. Thus, 
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(25) 


-* -** 

R * JL (26) 

i i+1 





-►* 

v. 
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(27) 


r = S - R (28) 

i i i-1 


The direction of is chosen to be either in the direction of 

a^. Conditions for these options are shown in table I and are dependent on the rela- 
tionship between consecutive lines of rotation. Correspondingly consistent equations 
for determining 0^ and are shown in table II. 

• i 

Equation for tan 9.^.- All the equations for tan 0^ in table II have similar 
explanations; therefore, only consider 


-> 

u. 
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> 
X u 


i+1 


or 


tan 0. 
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. -► ■> 
(a i-i x V 


u . 

X 


i-i 


a . 
x 


(29) 


The numerator term in equation (29) shows the cross product of a vector 
along x i_-j and a vector a^ along X i and then forming the dot product of the 
result and a unit vector u. along produces H^_ 1 H sin 0 i with the 

correct sign for a positive rotation about positive (or equivalently u^). 

V V I • 

The denominator is lla^-jO lla^ll cos 0^ Hence, the fraction represents tan 0^, 
where 0 < 9^ < 2n» The joint angle 0^ in equation (29) corresponds to the fixed 
position of joint ^i after u^ has been determined and joint i + 1 is being 
varied to obtain 
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Tan a. with X. 
1 1 


in direction of 


a. 

i 


- The appropriate equation in table II is 


tan a. 
1 



x Vi ’ 



(30) 


The right-hand side of this equation shows the cross product of a vector along 
z i-1 (° r u i^ and a vector along Z i (or u i+1 ^ and then the dot product of this 

result and a unit vector along (or a. /Ha. II ) gives sin a.- The dot product in 

the denominator yields cos 

Tan ol with in direction of x when consecutive lines of rotation 

intersect .- Figure 9 shows the unit vector u i+1 along Z^$ the unit vector u. 
along a line parallel to and the angle between these two vectors. A unit 

vector defined by 


U. X u. 

_ 1 1+1 

1 “ -y + 

llu . Xu. „ 
1 1+1 


(31) 


establishes the direction of Hence, 


tan a. 
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(u. X u ) • <5. 
v 1 1+1' 1 

-y •> 
u. • u, ^ 
i i + l 


(32) 


is the ratio of sin to cos a^- Or, equivalently. 


tan a. = 


llu. x u I 
l i+l 


l + + 

u . • u. 

i i+l 


( 33 ) 


which is shown in table II. 
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Calibration of Joint Angles 


i 

The joint angle 0. can be calibrated as follows. After positional data 
(k) are obtained for variations in the joint angle 0^, let 0* be the fixed 
value of 0^ when the next positional data £. + ^(k) are collected for variations in 
^i+1* More °ver # let ( 0 M be the value of 0^ that is computed with the positional 
data in the parameter extraction procedure. Then, ( 0^ ) corresponds to 0*. If 
the functional relationship between 0^ and 0^ is the linear equation (3), then 


- Oi.) - 


e: 


(34) 


Thereafter, with this value of (3^ equation (3) gives 0.^ for different values of 

0 . - 
l 

Extraction of the Denavit-Hartenberg parameters allows the definition of joint 
axis systems for the robot arm, such as those depicted in figure 10. The procedure 
in this analysis applies not only to robot arms but also to other jointed mecha- 
nisms. In addition, errors are not propagated. Although only rotational joints are 
discussed in the text, translational or sliding joints are easily handled as indi- 
cated in appendix B . 


CONCLUDING REMARKS 

A vector-algebra method is developed to extract the relative joint geometry 
(Denavit-Hartenberg parameters) of a robot arm or other jointed mechanisms. The only 
measurements required are the locations of a point on the robot hand for different 
joint angles. A minimum of four locations (i.e., world coordinates for four loca- 
tions of the point) is required; however, more points should be used to reduce the 
effects of measurement errors. The robot arm is positioned by changing a set of 
joint angles (which are referenced to an arbitrarily specified zero position), and 
then the location of a point on the* robot hand is measured with respect to a fixed 
world axis system (which is also arbitrarily specified) . These positions and joint 
angles are used in equations to extract the relative joint parameters. More specifi- 
cally, trajectories generated by a point on the robot arm (circular trajectory for 
rotational joints and line trajectory for sliding joints) and obtained by individual 
joint movements provide sufficient information to determine unit vectors along the 
lines of rotation or translation and to subsequently extract the Denavit-Hartenberg 
parameters. 

This method for extracting relative joint geometry of robot arms will be useful 
to researchers who need these data for existing robot arms for either validation of 
mathematical models or for studies involving the actual control of these devices. 

This method, which does not require the robot arm to be disassembled, may also be 
useful in the recalibration of a misaligned or bent robot arm and, if sufficiently 
accurate, could become a useful industrial procedure. A merit of the method is that 
errors are not propagated. 


Langley Research Center 

National Aeronautics and Space Administration 
Hampton, VA 23665 
July 11, 1983 
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APPENDIX A 


WORLD COORDINATES OF POINT F BY SINGLE SIGHTING DEVICE 
The symbols used in this appendix are defined as follows: 
d distance from origin of world axis system to point F 

F point associated with robot arm; center of sphere 

x w' y w' z w world coordinates 

y,y 1^2 elevation angles of sighting device 

y elevation angle such that if line of sight is lowered suf f iciently , it will 

pass through center of sphere 

p known sphere radius 

s 

(Jj azimuth angle of sighting device 

The parameter-extraction method presented in the text uses the world coordinates 
of a point F on the robot arm as input data. There are several ways to gather this 
information, with some ways being more accurate than others. 

A technique which might be useful in obtaining the world coordinates of a 
point F is shown in figure A1 . Since point F is somewhat arbitrary, consider it 
to be the center of a sphere of known radius p s on an extension that is held by the 
robot hand. For reference, an arbitrary reference point is selected so that when it 
is sighted, the azimuth angle (\> and elevation angle y of the transit are con- 
sidered to be zero. Now, (\> is increased by changing y until a line-of-sight 
tangent to the sphere is produced at y = y 2 * With <J> constant, y is then reduced 
to y = y which corresponds to the other line-of-sight tangent. The desired eleva- 
tion angle y 2 is the maximum elevation angle Y m ax exists as cj; is 

increased, as indicated in figure A2. With these line-of-sight angles, the distance 
to point F is 


d = 



( Al ) 


and the world coordinates are 


z 

w 


d sin 




( A2 ) 
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APPENDIX A 


y 


w 


X 

w 



sin <|> 


cos c|> 


(A3) 


( A4 ) 


No measurements were made to ascertain the accuracy of this measurement 
technique • 
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Sphere on extension 
attached to robot hand 






Figure A2.- Illustration of maximum elevation angle for line-of-sight tangent 

line to spherical surface. 
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APPENDIX B 


RELATIVE JOINT GEOMETRY FOR SLIDING JOINTS 

In the text, primary emphasis is placed on rotational joints; however, the same 
basic analysis holds for sliding joints (extendable segments). Let r be the 
extension variable and a constant for joint i + 1 in the robot arm. 

Measuring locations of a point F on the robot arm for two different extensions 
(£ i+1 (k), where k = 1 and 2) gives two points on a line. Let P i+ ^(1) correspond 

to the extension ? i+1 = r i+<| (1) and $ i+1 (2) correspond to r ±+1 = r ± +^(2), where 

llr. +< |(2)ll > llr^ +1 (1)ll. Then, instead of the unit vector in equation (9), the unit 

vector is 


u 


1+1 


Vi< 2) ' Vi (1) 


“W 2 > - 1 


i+1 


(1) 


(B1 ) 


Furthermore, instead of the line equation (12), the new line equation is 



J i + i m 


X i+1 


U i+1 


(B2) 


The remaining steps in the parameter extraction are the same as in the text. 

The line of extension represented by equation (B2) can be shifted, if desired, 
to pass through some chosen point; for example, the P^ + ^(1) t * ie e< l uat i on can ke 

replaced by ^ . This makes the a^ terms in equation (2) equal to zero for slid- 

ing joints (ref. 5). 
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Figure 2.- World axis system and robot arm with extension for measurements. 
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Figure 9.- Geometry illustrating defined in direction of 


t 



Figure 10.- Robot arm with axis systems. 
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